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[57] ABSTRACT 

A simple and computationally efficient approach is disclosed 
for on-line coordinated control of mobile robots consisting 
of a manipulator arm mounted on a mobile base. The effect 
of base mobility on the end-effector manipulability index is 
discussed. The base mobility and arm manipulation degrees- 
of-freedom are treated equally as the joints of a kinemati- 
cally redundant composite robot. The redundancy intro- 
duced by the mobile base is exploited to satisfy a set of 
user-defined additional tasks during the end-effector motion. 
A simple on-line control scheme is proposed which allows 
the user to assign weighting factors to individual degrees- 
of-mobility and degrees-of-manipulation, as well as to each 
task specification. The computational efficiency of the con- 
trol algorithm makes it particularly suitable for real-time 
implementations. Four case studies are discussed in detail to 
demonstrate the application of the coordinated control 
scheme to various mobile robots. 
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ON-LINE METHOD AND APPARATUS FOR 
COORDINATED MOBILITY AND 
MANIPULATION OF MOBILE ROBOTS 

ORIGIN OF INVENTION 

The invention described herein was made in the perfor- 
mance of work under a NASA contract, and is subject to the 
provisions of Public Law 96-517 (35 USC 202) in which the 
Contractor has elected not to retain title. 

TECHNICAL FIELD 

The present invention relates to a new method and appa- 
ratus for providing a simple and computationally efficient 
approach for on-line coordinated control of mobile robots 
consisting of a manipulator arm mounted on a mobile base. 
The redundancy introduced by the mobile base is used to 
satisfy a set of user-defined additional tasks during the 
end-effector motion. A simple on-line control scheme has 
been developed that allows the user to assign weighting 
factors to individual degrees-of-mobility and degrees-of- 
manipulation, as well as to each task specification. The 
computational efficiency of the control algorithm makes it 
particularly suitable for real-time implementations. 

BACKGROUND ART 

Conventional robots are mounted on a stationary base 
bolted to the floor so that they can withstand the forces and 
torques applied to the base when the arm carries a payload. 
Nowadays, with the availability of low-cost high-perfor- 
mance computers, real-time control algorithms can be 
implemented for mobile-base robots. Base mobility extends 
the reach of the manipulator arm considerably, and hence 
increases the size of the robot workspace substantially at a 
low cost. The base mobility can take different forms and four 
common implementations are: 

(i) Tracked Robots: The robot base is mounted on a 
platform that can move back and forth along a track 
installed on the floor. Welding and painting robots are 
the most common tracked robots; 

(ii) Gantry Robots: The robot is mounted on an overhead 
gantry that provides mobility in two horizontal direc- 
tions and one vertical direction. These robots can carry 
very large payloads and can operate where floor space 
is critical; 

(iii) Wheeled Robots: The robot is mounted on a vehicle 
that can move on wheels. Examples of this class are the 
microrovers planned for space exploration; 

(iv) Compound Robots: The robot base is supported by 
another robot manipulator bolted to a fixed structure. 
The inner robot is typically a crane arm used as a crude 
positioning device. This robot has a large work enve- 
lope, slow movement characteristics, a high payload 
handling capacity, and is often referred to as the 
“marco” manipulator. The outer robot is a smaller and 
lighter manipulator that can provide dexterous manipu- 
lation with fast and precise movement capability, and is 
often called the “micro” manipulator. The robot system 
planned for the Space Station Freedom is a compound 
macro/micro manipulator. 

A search of the prior art has revealed the following U.S. 
Pat. Nos.: 

4,483,407 Iwamoto et al 

4,590,578 Barto Jr. et al 

4,702,661 Bisiach 


4,706,204 Hattori 
4,804,897 Gordon et al 
4,853,603 Onoue et al 
4,894,595 Sogawa et al 
" 4,937,511 Herndon et al 

4,954,762 Miyake et al 
5,021,878 Lang 
5,031,109 Gloton 
10 5,155,423 Karlen et al 

5,156,513 Galan et al 
5,157,315 Miyake et al 
5,245,263 Tsai et al 
15 5,260,629 Ioi et al 

Of the aforementioned patents, the following appear to be 
relevant: 

U.S. Pat. No. 4,590,578 to Barto Jr. et al is directed to an 
off-line programmable robot. As FIG. 1 shows, robot 10 
20 having articulated arm 12 is fixed on base 22 which, in turn, 
is mounted on carriage track 40. A single controller, con- 
troller 70, controls both the motion of articulated arm 12 
about the six axes 14-19, as well as the movement of the 
base along a seventh axis 42. In order to maintain accuracy 
25 in the location of the machine operations on workpiece 34, 
controller 70 performs “on the fly” determination of the 
positional relationships between workpiece 34, fixture 36, 
touch blocks 43-48, track 40, and robot 10. 

U.S. Pat. No. 4,954,762 to Miyake et al is directed to a 
30 method and apparatus by which the tracking path of an 
industrial robot relative to other movable elements is con- 
trolled. As FIG. 1 shows, robot 1 is mounted on travelling 
stand vehicle 2 which is movably mounted on stand base 20. 
A single microprocessor 61 controls the relative orientation 
35 of robot arms 10, 11, 12 and 13 which manipulate welding 
torch 30; travelling stand vehicle 2; and positioner 4 which 
holds working object 5. Thus, manipulation of robot 1 and 
its translational movement are under real time coordinated 
control, as in the disclosed concept. 

40 U.S. Pat. No. 4,894,595 to Sogawa et al is directed to an 
industrial robot. As FIG. 1 shows, the industrial robot 
comprises arm arrangement 1 supported on base 3 with drive 
units 3X, 3Y and 3Z, defining the mechanical interface 
between the two. Control unit 5 which includes command 
45 section 7 and position designation device 6, as shown in 
FIG. 2, coordinates the movement of robot arm 1, hand 2, 
and driven members 4A and 4B about their respective axes 
of motion. Here again, one controller commands the trans- 
lational and manipulator movements of a robot arm. 

50 U.S. Pat. No. 5,260,629 to Ioi et al is directed to a control 
device for a robot in an inertial coordinate system. As FIG. 
2 diagrams, the control device operates on a system com- 
prising robot 1 with a number of arms 3 and body 2, each of 
which have multiple degrees of freedom. The approach 
55 essentially is to measure the velocity or acceleration of robot 
body 2 with accelerometer 14 contained therein, then to add 
that measured parameter to a desired value expressed in 
absolute coordinates so as to command the robot arm to 
follow any desired path within that absolute coordinate 
60 system. Thus, translation of robot body 2 and the movement 
of robot arm 1 are coordinated, within a common coordinate 
system. 

U.S. Pat. No. 5,156,513 to Galan et al is directed to an 
apparatus for handling clothes on hangers. As shown in FIG. 
65 1, the apparatus is basically an auto-guided vehicle with 
manipulators for the controlled handling of clothes on a 
hanger. The relevance to your concept here is that control of 
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auto-guided vehicle 2, article arm 4, horizontal arm 5, and 
clamp 6 is provided by a common onboard computer. 
Accordingly, the DC motors controlling each of these com- 
ponents are appropriately turned on and off by that onboard 
computer. 5 

In recent years, there has been a growing interest in the 
analysis and control of mobile robots. Carriker, Khosla, and 
Krogh formulate the coordination of mobility and manipu- 
lation as a nonlinear optimization problem. A general cost 
function for point-to-point motion in Cartesian space is 10 
defined and is minimized using a simulated annealing 
method. Pin and Culioli define a weighted multi-criteria cost 
function which is then optimized using Newton’s algorithm. 

Lin and Lewis describe a decentralized robust controller for 
a mobile robot by considering the base and the robot as two 15 
separate subsystems. Finally, Hootsmans and Dubowsky 
develop an extended Jacobian transpose control method to 
compensate for dynamic interactions between the manipu- 
lator and the base. 

The present invention departs from the previous 20 
approaches by treating the base degrees -of- mobility equally 
with the arm degrees-of-manipulation. Configuration con- 
trol formalism is then used to augment the basic task of 
end-effector motion by a set of user-defined additional tasks 
in order to exploit the redundancy introduced by the base 25 
mobility. The mobility and manipulation degrees-of-free- 
dom both contribute to the execution of the basic and 
additional tasks. This approach is simple and computation- 
ally efficient and is therefore well-suited for on-line control 
of mobile robots. 30 

STATEMENT OF THE INVENTION 

The present invention provides an on-line method for 
coordinated arm and base motions by augmenting the hand 
motion with a set of user-specified additional tasks. The 35 
configuration control formalism is then used to determine 
the arm and base motions needed to accomplish the aug- 
mented task. 

In the simple scheme presented here for coordinating 
mobility and manipulation in a mobile robot system, the 40 
degrees-of-mobility are added to the degrees-of-manipula- 
tion, and the overall degrees-of-freedom (DOF) are used to 
accomplish a set of user-defined tasks in addition to end- 
effector motion. This formulation puts the mobility DOF on 
the same footing as the manipulation DOF and treats them 45 
equally within a common framework. 

The key advantages of this approach over the previous 
schemes are its flexibility, simplicity and computation effi- 
ciency. The ability to change the task specifications and the 5Q 
task weighting factor on-line based on the user require- 
ments, provides a flexible framework for mobile robot 
control. 

Furthermore, in contrast to previous approaches which are 
suitable for off-line motion planning, the simplicity of the 55 
present approach leads to computational efficiency which is 
essential for on-line control in real-time implementations. 
This approach is based on the inventor’s prior work, but the 
resulting approach taken for coordinating mobility and 
manipulation in this solution is completely new. 60 

The four case studies discussed in detail herein demon- 
strate the application of this coordinate control scheme to 
various mobile robots. 

OBJECTS OF THE INVENTION 

65 

It is therefore a principal object of the present invention 
to provide a method for on-line control of mobile robots by 


4 

treating the robot base’s degrees-of-mobility equally with 
the arm’ degrees-of-manipulation. 

It is an additional object of the present invention to 
provide a method and apparatus for computationally effi- 
cient, on-line control of mobile robots wherein redundancy 
introduced by the mobile base is used to satisfy a set of 
user-defined additional tasks during end-effector motion. 

It is still an additional object of the present invention to 
provide a method for coordinating mobility and manipula- 
tion in a mobile robot system wherein task specifications and 
task weighting may be changed on-line based on user 
requirements. 

BRIEF DESCRIPTION OF THE DRAWINGS 

The aforementioned objects and advantages of the present 
invention as well as additional objects and advantages 
thereof will be more fully understood as a result of a detailed 
description of preferred embodiments when taken in con- 
junction with the following drawings in which: 

FIG. 1 illustrates a two-link robot arm mounted on a 
single axis movable cart to provide a prismatic joint and two 
re volute joints; 

FIG. 2, comprising FIGS. 2 (a) through 2(d), illustrates 
four possible arm configurations of the robot of FIG. 1 for 
a maximum manipulability configuration; 

FIG. 3, comprising FIGS. 3(d) through 3(f), is a graphical 
illustration of a first computer simulation of the effects of 
three different velocity weighting factors on the robot of 
FIG. 1; 

FIG. 4, comprising of FIGS. 4(a) through 4(f) , is a 
graphical illustration of a second computer simulation of the 
effects of three different position feedback gains on the robot 
of FIG. 1; 

FIG. 5 illustrates a single-link robot arm mounted on a 
double axis movable vehicle to provide a pair of prismatic 
joints and a pair of revolute joints; 

FIG. 6 illustrates a mobile robot having a spatial three- 
jointed arm on a one degree of freedom mobile platform 
providing a single prismatic joint and three revolute joints; 

FIG. 7, comprising FIGS. 7(a) through 1(h), is a graphical 
illustration of a first computer simulation of the effects of 
three different velocity weighting factors on the robot of 
FIG. 6; 

FIG. 8, comprising FIGS. 8 (a) through 8 (h), is a graphical 
illustration of a second computer simulation of the effects of 
three different velocity weighting factors on the robot of 
FIG. 6 where task weighting is varied as a function of 
velocity weighting; 

FIG. 9 illustrates a mobile robot having a spatial four 
revolute joint arm mounted on a single axis base treated as 
a single prismatic joint; 

FIG. 10 is a graphical illustration of the variation of the 
arm reach as a function of elbow angle for the robot of FIG. 
9; and 

FIG. 11 is a graphical illustration of the variation of task 
weighting as a function of elbow angle for the robot of FIG. 

9. 

DETAILED DESCRIPTION OF PREFERRED 
EMBODIMENTS 

The system considered first herein consists of a robot 
manipulator mounted on a mobile base. Although the physi- 
cal appearance of mobile robots are completely different, 
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their underlying kinematic principles can be formulated in a 
similar manner. The overall manipulator arm-plus-mobile 
base system can be viewed as a composite of two sub- 
systems: the robot arm with n a degrees-of-freedom, and the 
mobile base with n b degrees-of-freedom. The n a degrees- 5 
of-manipulation are often of the revolute joint type. The n b 
degrees-of-mobility can be treated as prismatic joints in 
tracked, gantry or wheeled robots or as revolute joints in 
compound robots. Let us define a fixed world frame of 
reference {W} in the robot workspace, a moving base frame 1Q 
{B} attached to the manipulator base, and a moving end- 
effector frame {E} is related to the base frame {B} by the 
4x4 homogeneous transformation matrix T B E (0J , which is 
the product of the arm joint- to-joint transforms. The trans- 
formation that relates the base frame {B} to the world frame 15 
{W} is denoted by T W B (0 J, and is obtained by multiplying 
the base inteijoint transforms. Thus, the end-effector frame 
{E} is related to the world frame {W} by the 4x4 homo- 
geneous transformation matrix 

a ) 20 

R '■ M 

r w £ =r w B (8i,)T/(e (I )=J 

\ 0 0 0 1 / 

where R={r iy } is the 3x3 end-effector rotation matrix and 25 
p=[x, y, z] T is the end-effector position vector, both with 
respect to the world fram {W}. One common three-param- 
eter representation of the^ end-effector orientation is the 
equivalent angle-axis pfc=[k r , k^, kj r which can be extracted 
readily from the rotation matrix R. Therefore, the m(^ 6 ) 30 
end-effector position and orientation coordinates to be con- 
trolled can be obtained from (Equation (1)) and represented 
by the mxl vector 

Y=f(0 a , e b ) (2) 35 

Equation (2) describes the forward kinematic model that 
relates the arm and base joint coordinates { 0 a , 0 ^} to the 
end- effector Cartesian coordinates Y in the fixed world 
frame {W}. The differential kinematic model that relates to 40 
the end-effector Cartesian velocity Y to the arm and base 
joint velocities { 0 a , 0 fo } is given by 

r e ° 1 (3) 

y= we) : Mm ^ =mw 45 

where 


6 

where the total joint degrees-of-freedom n exceeds the 
end-effector task dimension m. When the base is stationary, 
the end-effector manipulability index due to the arm joints 
{d a } is defined as Equation (11) 

^(0Mdet[J a (e)J/(0)]} 1/2 (4) 

Note that in any nonsingular arm configuration, J fl (0)J fl r (0) 
is a symmetric positive-definite matrix whose determinant is 
a positive function of {0 a }. Now, when base mobility is 
introduced, the end-effector Jacobian matrix changes from 
J a to J e =[J a ;JJ, and the end-effector manipulability index 
due to both arm and base joints { 0 }-{ 0 a , 0 &} is obtained as 

fc(9) = {det[7 e (0)7/(0)]}^ (5) 

= {det[7 fl (0)//(0) + JMJb T m } 1/2 

It can be shown that 

A,(0 >^(0)+a(0) (6) 

where a( 8 ) is a positive function of 0. Equation ( 6 ) implies 
that the base mobility always enhances the end-effector 
manipulability index. This is expected in view of the fact 
that the base degrees-of-freedom contribute to the end- 
effector motion and thereby increase the Cartesian mobility 
of the end-effector. At singular arm configurations, J a (0) is 
rank-deficient and p a (0)=O. In this case p c (0)^p a (0); that is 
the base mobility can in general increase the end-effector 
manipulability index, however in certain cases p e ( 0 ) is also 
equal to zero. We conclude that in general, the end-effector 
manipulability index is increased by the presence of base 
mobility. 

Let us now consider the coordinated control of the com- 
posite arm-plus-base system. The composite system is kine- 
matically redundant with the degree-of-redundancy n-m, 
since Equation (2) can produce infinite distinct joint motions 
{ 8 fl (t) , ©^(t)} which yield the same end-effector trajector 
Y(t). We adopt the configuration control approach in which 
an appropriate joint motion is chosen from this infinite set 
which causes the composite robotic system to accomplish an 
additional user-specified task. This additional task is per- 
formed by direct control of a set of r(=n-m) user-defined 
kinematic functions <j>=g( 0 ) while controlling the end-effec- 
tor motion, where and g are rxl vectors. This is achieved 
by augmenting the m end-effector coordinates Y in Equation 
( 2 ) by the r kinematic functions <|) to yield the nxl configu- 
ration vector X as 


dr dr 

SeT andA(e)= “507 


are the mxn a and mxn b Jacobian matrices of the arm and the 
base, respectively, 



is the nxl vector of mobility and manipulation joints, and 
n=n fl +n b . This formulation puts the n b mobility and the n a 
manipulation degrees-of-freedom on the same footing, and 60 
treats both Q a and Q b equally within a common framework. 
Equations (2) and (3) describe the kinematics of a composite 
robotic system with n joint degrees-of-freedom operating in 
an m-dimensional Cartesian task space. 

Before discussing coordinate control of mobility and 65 
manipulation, let us investigate the effect of base mobility on 
the end-effector manipulability index in the common case 


-CMS)- 

Equation (7) represents the augmented forward kinematics 
of the composite robotic system. This approach to redun- 
dancy resolution is very general since each kinematic func- 
tion {<t> r (t)} can represent a geometric variable (e.g., coor- 
dinate of a point on the robot), a physical variable (such as 
a joint gravity torque), or an abstract mathematical function 
(e.g., projection of the gradient of an objective function). 
Furthermore, the user is not confined to a fixed set of 
kinematic functions and can select, different {^(t)} depend- 
ing on the task requirements during the execution of the 
end-effector motion. Once the kinematic functions {<(>,(0)} 
are selected, the user defines the desired time variations of 
these functions {^(t)}- Therefore, the redundancy is uti- 
lized so that the manipulator satisfies a set of r kinematic 
constraints 


i=l, . . . ,r 


( 8 ) 
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while executing the desired end-effector motion. In other 
words, let the nxl desired configuration vector be denoted by 



where Y rf (t) defines the prescribed end-effector motion 
(basic task) and <j)^(t) represents the desired evolution of the 
kinematic functions (additional task). The configuration 
control approach is to find the required joint motions such 
that the configuration vector X(0) tracks the desired trajector 10 
X rf (t). This formulation puts the redundancy resolution con- 
straint on the same footing as the end-effector task, and 
treats both Y and (J) equally in a common format. The 
configuration control problem can be solved either by a 
dynamic controller which generates the required joint 
torques F(t), or alternatively by a kinematic controller that 15 
produces the appropriate joint commands 0 rf (t). We adopt the 
kinematic control implementation, and furthermore to 
address the general case where there are no close-form 
analytical inverse kinematic solutions, the differential kine- 
matics approach is used. In the general case where r(^n-m) 20 
additional tasks are specified, the augmented differential 
kinematic model of the manipulator arm-plus-mobile base 
system is obtained as 


X(f) = 



where 


j a m 


4(0) 


j b m \ 1 00 


0b 


( 10 ) 


25 


= 7(0)0 


4(0) = 


ae 


30 


is the rxn Jacobian matrix associated with the kinematic 
functions <|), and J(0) is the (m+r)xn augmented Jacobian 
matrix. To find the base mobility and arm motion that meet 35 
the end-effector specification Y(0)=Y d (t) and the kinematic 
constraints <j)(0)=<t> rf (t), we need to solve the augmented 
differential kinematic equation 


x,(t)=J(e)e(t) (li) 

To avoid large joint velocities, the user can impose the 
velocity weighting factor W v = 



40 


45 


and attempt to minimize the weighted sum-of- squares of 50 
joint velocities 

\Mlr a + Ml b . 

Typically, the base movement is much slower than the arm 55 
motion and W & is much larger than W a . In addition, the user 
can assign priorities to the different basic and additional task 
requirements by selecting the appropriate task weighting 
factor 

60 

w e : o \ 

o \ w c J 
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and seek to minimize the weighted sum of task velocity 
errors 


\\k\^ e + \\EA c , 


where E e =Y rf -J e 0 and E c =(j)^-J c 0 are the end-effector and 
constraint velocity errors. Hence, we seek to find the optimal 
solution of Equation (11) that minimizes the scalar cost 
function 

i = pa , + 119^+11^-^+ \\<s>d-m^ c (12) 

= e 0 nv 0 e 0 + e/m +k e T w e E c +kjw c k c 

The optimal damped-least-squares solution of Equation (11) 
that minimizes Equation (12) is 


Q=[J T W { J+W v ]~ 1 J r W t X d ( 13) 

Note that in the special case where i^n-m and W v =0, 
Equation (13) gives 


e=r% (14) 

assuming det[J]^0, which is the classical inverse Jacobian 
solution. To correct for task-space trajectory drift which 
occurs inevitably due to the linearization error inherent in 
differential kinematic schemes, we introduce the actual 
configuration vector X in Equation (13). 


e=[7 7 'W ( /+W v ]-V 7 *WJX rf +K(Xs-X)\ (15) 

where K is an (m+r)x(m+r) constant diagonal matrix with 
positive diagonal elements. The introduction of the error 
correction term K(X d ~X) in Equation (15) provides a 
“closed-loop” characteristic whereby the difference between 
the desired and actual configuration vectors is used as a 
driving term in the inverse kinematic transformation. Note 
that for task-space trajectories with constant final values, 
X^tjMD for t^T^T where t is the motion duration, and 
using Equation (13) we obtain 0(t)=O for t^T; i.e., the arm 
and base joints will cease motion for ti^T and any task 
tracking -error at t=x will continue to exist for t>r. However, 
by using Equation (15) the arm and base joints continue to 
move for t^T until the desired configuration vector is 
reached, i.e., X^X d as t— The value of K determines the 
rate of convergence of X to X d . 

For digital control implementation, Equation (15) is dis- 
cretized as 

e(jv+i)-e(AQ _ 06) 

At 

_ r XdiN + V-XdiN) 1 

W + W V J-W, ^ — + KX d (N) - KX(N) J 


or 


0(;V-rl y=B(N)+[J T W r I+W v ]- 1 J T W l [X d (N+l)-(l~KAt)X d (M)~ 

KAtX(N)] (17) 

where N denotes the sampling instant and At is the sampling 
period. Equation (17) is used to compute 0(N+1) given 
{0(N),X^(N+l),X rf (N),X(N)}. Note that in the special case 
when 



9 
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K =~kr=f’ 

where f is the sampling frequency, Equation (17) simplifies 
to 


Q(i^iy^{N}+[j r w t r+w v ]- 1 j r w t [x d (N+iyxm (is) 

This equation can be considered as the discrete-time version 10 
of Equation (13) with the desired position X rf (N) replaced by 
the actual position X(N) to correct for drift. Notice that, in 
practice, die inversion of the positive-definite matrix 
[J^WjJ+WJ is not needed, and 0(N+1) can be found using 
the Cholesky decomposition. 15 

The proposed damped-least-squares configuration control 
scheme provides a general and unified framework for coor- 
dinated control of mobility and manipulation, allows inde- 
pendent weighting of base movement and arm motion, and 
enables a wide range of redundancy resolution goals to be 20 
accomplished. Note that multiple goals can be defined for 
redundancy resolution and weighted appropriately based on 
the current task requirements. 

In summary, the procedure for coordinated control of base 
mobility and arm manipulation is as follows: 25 

1. Augment by column the arm Jacobian J a with the base 
Jacobian J b to obtain the overall end-elfector Jacobian 
3 e =[3 a ‘ : J b ]. Note that the availability of base mobility 
appears as extra columns in the Jacobian matrix, since 

in effect it increases the dimension of the joint space. 30 

2. Augment by row the end-effector Jacobian 3 e with the 

constraint Jacobian J c which relates to the user-defined 
additional task to be accomplished due to kinematic 
redundancy. 35 

This yields the augmented Jacobian 



40 


Note that the additional task leads to extra rows in the 
Jacobian matrix, since it effectively increases the dimension 
of the task space. 

3. Specify the end-effector and constraint task weighting 
factors W,=diag{W e , W c } and the arm and base joint 45 
velocity weighting factors W v =diag{W fl , W,,}. 

4. Use the closed-loop damped-least-squares approach to 

find the optimal arm and base motions as 
6=[J 7 ’W r F+W v ]' 1 J r W f [X rf +K(X rf -X)]. 50 


CASE STUDIES 


We present four case studies demonstrating coordinated 
control of mobility and manipulation. The cases are chosen 
to represent common examples of mobile robots with both 55 
revolute (R) and prismatic (P) joints. Case studies 1, 3, and 
4 are concerned with tracked robots where base mobility is 
provided as a prismatic joint. In case study 2, a vehicle with 
3 DOF is used to produce base motion. For each example, 
a complete analysis of the arm-plus-base singularities is 60 
given. Each example illustrates a particular aspect of coor- 
dinating mobility and manipulation. 

Case Study 1: Planar 2R-1P Mobile Robot 

Consider a two-link robot arm mounted on a cart, as 65 
shown in FIG. 1. The cart motion along the x-axis is treated 
as a prismatic joint 0 3 and the arm joints 0 X and 0 2 are 


10 

considered as revolute joints of the overall 3 DOF robot. The 
forward kinematic model that relates the tip position Y=(x, 
y) r in the fixed world frame to the joint displacements 0=(0 ls 
0 2 ,0 3 ) r is given by 


Jt=cos Bj+cos 0 2 +a0 3 y=sin B^sin 0 2 (19) 

where the joint displacement 0! and 0 2 are the absolute 
angles measured relative to the positive x-axis, and the link 
lengths are assumed to be unity. The scalar parameter a is 
introduced in Equation (19) to allow comparison of the 
stationary -base case (a=0) with the mobile-base case (a=l). 
The differential kinematic model that relates the joint veloci- 
ties 0=(0 ls 0 2 , 0 3 ) r to the resulting tip velocities Y=(x, 
y) T is given by 


. / — sin0i -sin0 2 a \ . ( 2 ^) 

y = \cos 01 COS02 oj e = « e)e 

where J e (0) is the 2x3 tip Jacobian matrix. At any joint 
configuration 0, the tip manipulability index p(0), which 
represents the ability to change the tip x and y coordinates, 
is defined to be 

m = { det[/ e (0)//(0)] } m (21) 

= {sin 2 (0 2 - 00 + a 2 [cos 2 0i + cos 2 02l} 1/2 

From Equation (21), it is seen that p(0) contains two 
components. The first component sin 2 (0 2 -0i) is the classi- 
cal manipulability index for a stationary -base two-jointed 
arm. The second component a 2 [ cos 2 B^+c os 2 0 2 ) is due to 
the presence of base mobility. Note that the base mobility 
always increases the manipulability index, as discussed 
above. Equation (21) indicates that p(0) is positive for all 0, 
i.e., the rows of J e are always independent and the robot does 
not have any tip singularities, except when Pi-0^0 
degrees, which corresponds to the arm in the vertical con- 
figuration (parallel to the y-axis) which puts the tip on the 
workspace boundary. In this case, the second row of J e 
vanishes and the joint velocities (0 l9 0 2 , 0 3 ) do not contribute 
to the y- velocity (y). Note that his result stands in contrast 
to the classical tip singularities for a stationary-base two- 
jointed arm (a=0 case) which occur when 02-0! or 0 2 =18O 
degrees +00 i.e., when the arm is fully stretched or fully 
folded. The reason for lack of tip singularities for the 
mobile-base two-jointed arm in these configurations is that 
the base mobility 0 3 allows complete control of the tip 
x-coordinate, while the tip y-coordinate can be controlled by 
either of the arm joints B l or 0 2 . We conclude that the base 
mobility has considerably reduced the singular configura- 
tions of the arm. 

Consider the tip manipulability index p(0) given by 
Equation (21). In the case of stationary base (a=0), the 
manipulability index p(0)=l sin (0 2 ~0i) attains its maximum 
value of unity when 0 2 -0j= 9O degrees, i.e., when the 
upper-arm and forearm are perpendicular, which is a clas- 
sical result obtained originally by Yoshikawa. However, in 
the case of mobile base (a=l), the robot configuration with 
maximum manipulability index is obtained by solving 


3n 2 (0) 

00 ! 


= -2sin(02 - 0i)cos(02 - 0i) - 2cos0isin0i = 0 


dn 2 (6) 

002 


= 2sin(02 - 0i)cos(0 2 - 0i) - 2cos02sin0 2 = 0 


( 22 ) 


FIGS. 2(a)-2(d) show the four possible arm configuration 
that satisfy the optimality condition Equation (22), together 
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with their associated cost function p 2 . It is seen that the arm 
configuration having the maximum p(0) is given by 0i=±3O 
degrees, 0 2 =±3O degrees, yielding jli 2 -2.25. In fact, the 
classical configuration 0 2 -0 1 =9O degrees is no longer an 
optimal solution with |3=2. 

Let us now consider the coordinated control of the cart 
mobility and arm manipulation. The robotic system shown 
in FIG. 1 is kinematically redundant since it has a three- 
dimensional joint space (n=3) and only a two-dimensional 
task space (m=2). The single degree-of-redundancy (n-m= 
1) can be used to perform any user-defined task, in addition 
to the basic task of tip placement. In this section, we define 
the additional task as optimization of the manipulability 
index. However, since a truly optimal configuration will fix 
both revolute joints 0j and 0 2 , we propose to use the 
classical suboptimal configuration 0 2 -0!=9O degrees, which 
imposes only one constrain on 0 X and 0 2 . This reasonable 
since the degradation of p 2 due to this suboptimal configu- 
ration is only 12.5% relative to the truly optimal configu- 
ration. Hence, the additional task is defined as 


<j>(0)=18O°-(0 z-ed^r) (23) 

where the elbow angle <J) is the relative angle between links 
1 and 2 , and <f> rf (t) is the desired elbow angle trajectory. We 
can now augment the basic task of tip motion by the 
additional task Equation (23) to obtain the augmented task 


*(0)=cos 0J+COS 0 2 +0 3 =x d (O j(0)=sin O^sin 0 2 ^y d (r) <J)(0)=18O°- 
(0 2 -0i)^(O (24) 



/o 0 o\ 

’ 


’ Xd -t- k(Xd - x) 

e = 

S r J + 1 0 0 0 



yd+ttyd-y) 

5 

( 0 0 y ) 



_ (j> d + £(<[></ -<|>) 


where k is a positive scalar. Let us assume that initially, the 
base is at 0 3 =1.O meter and the arm joint angles are 0j=45 
degrees, 0 2 =9O degrees; yielding the initial tip position 
x=y =1.707 meter and the initial elbow angle <|)/=135 
10 degrees. Suppose that we define the final configuration as 
Xy=4.0 meter, yy=1.0 meter, 4y=90 degrees. Notice that (j)y=90 
degrees ensures maximum manipulability for the end-effec- 
tor in the final configuration when the cart is stationary. The 
desired motion trajectories are specified as 


x d (t) = 


Xi + 


Xf-Xj 

— 


■ t 


x f 


, for t ~ i 
, for t > t 


(29) 


20 


25 


y<i(t) = 




ys-yi 

y i+ ——. t 


■y/ 






, for t %. x 
, for / > x 

, for t ~ x 
,fOTt>X 


where x is the duration of motion. Note that these trajectories 
produce a straight-line motion in task-space from (x f -, y,) to 
30 (Xy> y f ), sine 


where x rf (t) and y d (t) are the desired tip motion trajectories. 
The augmented task is therefore accomplished by solving 
the differential kinematic equation 

35 



Let us now examine the singularities of the 3x3 augmented 
Jacobian matrix 


40 


J = 


Je 


Jc 


45 


X~Xi 


y-yi 


Xf-Xi y f -y i 

Now, the desired task space velocities are 

Xf-Xi 




y<K.t) = 


Ut)~- 


X 

0 

yj-yi 

X 

0 


,t ^ T 
,t> T 


T 

, t>'l 


X 

0 


, / = T 
,t>X 


(30) 


as 


-sin8i 


det[J(Q)} = 


cos0i 


1 


-sin 02 

COS02 

-1 


1 

0 

0 


I=-(COS01 + COS02) 


(26) 


50 


Thus, the singular configurations of J are found to be 0 2 =18O 
degrees ±0 lt In these singular configurations, the tip y-co- 
ordinate and the elbow angle <j> cannot be controlled inde- 
pendently. 

Now, the base motion is often considerably slower than 
the joint movements, and it is therefore desirable to accom- 
plish the augmented task with as small a base velocity 0 3 as 
possible. The optimal joint motion which minimizes 


2HIV70 f+)03 2 (27) 

65 

where y is 0 3 weighting factor, is given by the closed-loop 
damped-least-squares solution of Equation (27) as 


To find the required joint motions, we substitute the task 
velocities ( x d , y d , Q d ) from Equation (30) into Equation (28) 
and solve Equation (28) to obtain the joint velocities (0 1} 
0 2 , 0 3 ). The acquired solution is then integrated numerically 
in discrete time to obtain the joint positions as 0(N+1)= 
0(N)+0At, where N is the sampling instant and At is the 
sampling period. The Jacobian matrix in Equation (28) is 
then recomputed using the new 0 and Equation (28) is 
solved and this procedure is repeated. 

Two computer simulation studies performed to demon- 
strate the effects of the cart velocity weighting factor y and 
the position feedback gain k on the system performance. In 
both studies, we take x^l sec, At=0.01 sec, the units of (x, 
y, (j>) are meters and radian, and Equation (28) is solved 
recursively for two seconds (i.e., 200 times). 

Case 1 — Effect of y: In this case, we set k-0 and solve 
Equation (28) under three different conditions y=0, 0.1, 1. 
The computer simulation results are presented in FIGS. 
3a-3/ (the units are changed to centimeters and degrees for 
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presentation), and the steady-state conditions of the system 
are shown in TABLE 1 . 


TABLE 1 



Effect of y on steady-state performance 
with k = 0 in case study 1 


03 

(cm) 

t 

(sec) 

X 

(cm) 

y (cm) 

(j> (deg) 

0i (deg) 

0 2 

(deg) 

y = 0.0 

2.0 

399.7 

99.9 

90.0 

-0.07 

89.9 

299.6 10 

y=0.1 

2.0 

383.8 

82.0 

97.3 

-8.2 

74.4 

258.0 

y = 1.0 

2.0 

330.3 

48.6 

114.6 

-15.9 

49.5 

169.1 


It is seen that when y=0, the tip x and y coordinates and the 
elbow angle cj) track the desired trajectories accurately and 15 
reach the specified target values in one second. When the 
cart velocity weighting y is increased to 0.1 and 1, the 
task-space tracking performance is degraded yielding 
steady-state errors; however, the required cart velocity is 2 o 
now smaller and the cart motion is reduced substantially, 
with higher y yielding lower velocity, as expected. There- 
fore, there is a trade-off between the task performance and 
the cart motion. 

Case 2 — Effect of k: In this case, we set y=l and solve 25 
Equation (28) under three different conditions k=0, 1, 10. 
The simulation results are presented in FIGS. 4a-4/and in 
TABLE 2. 


TABLE 2 




Effect of k on steady-state performance 
with y = 1 in case study 1 


0 3 

(cm) 

t 

(sec) 

x (cm) 

y (cm) 

<|> (deg) 0j (deg) 

0 2 

(deg) 

k = 0 

2 

330 

49 

115 -16 

49 

169 

k = 1 

2 

358 

75 

105 -9 

66 

218 

k = 10 

2 

399 

99 

91 -0.6 

89 

297 


It is seen that for k=0, the joint variables (0 l5 0 2 , 0 3 ) cease 
motion at t=l second and there are steady -state task-space 
tracking errors in x, y and When k is increased to 1 and 
1 0, the joints continue to move after t=l second until the task 
variables (x, y, <j>) converge to their target values (Xy> y p cjy). 45 
Note that the value of k determines the rate of convergence; 
with higher k yielding faster convergence. 


-/sin 0 isin 02 /cos 0 icos 02 1 0 

/cos 0 isin 02 /sin 0 icos 02 0 1 

0 -/sin 02 0 0 


( 32 ) 


M M 


02 

03 


= / c (0) 


02 

03 



W 


where J e (0) is the 3x4 tip Jacobian matrix. Since the robot 
has four joint coordinates (0 ls 0 2 , 0 3 , 0 4 ) and only three 
Cartesian tip coordinates (x, y, z) to be controlled, it is 
kinematically redundant with the degree-of-redundancy one. 
This allows us to accomplish one additional task beside tip 
placement through redundancy resolution. Suppose that the 
additional task is defined as the optimization of some 
user-defined kinematic objective function G(0). Then the 
condition for constrained optimization of G(0) is given by 
Equations (13) and (14). 


N e 


F dG dG dG 0G 

[lor ’"00T ’~W ,_ 5eT 



(33) 


where N c is the 1x4 vector that spans the null-space of the 
tip Jacobian matrix J e . This vector is found from the defi- 
nition NgJ,, 7 ^) as 


N e 32 [1, 0, / sin 0 X sin 0 2 , -l cos 0 X sin 0 2 ] 


(34) 


Let us now choose the objective function G(0) as a function 
of only the arm and vehicle rotational angles d 1 and 0 2 , i.e., 
G=G(0j, 0 2 ). Then 


dG _ dG 

003 004 


= 0 


and the optimality condition Equation (33) reduces to 

0G _ n (35) 

00i -u 

Therefore, in this case the constrained optimality condition 
for G, namely 


Case Study 2: Spatial 2R-2P Mobile Robot 50 

Consider the robot shown in FIG. 5 consisting of a 
single-link arm mounted on a vehicle with both Cartesian x 
and y translational motion and rotational motion (j) capabili- 
ties. Let us denote the arm joint angle by 0 1? the vehicle 55 
rotation by 0 2 (H ) X and let the prismatic joints 0 3 and 0 4 
represent the two translational motions of the vehicle in x 
and y-directions. The forward kinematic equations describ- 
ing the tip Cartesian coordinates X=(x, y, z) T relative to a 
fixed world frame are given by 


reduces to the condition for unconstrained optimization of G 
over 0j, that is 



This makes physical sense since 0 2 is fixed by the tip 
z-coordinate and 0j can always be compensated by 0 3 and 
0 4 motions to achieve desired tip x and y -coordinates. 
Now let us define the kinematic function 



cos 0 X sin 0 2 +0 3 y=l sin 0 X sin 0 2 +0 4 2=/ cos 0 2 +/z 


(31) 


and the desired value as Then ((>=1^0, where 


where 1 is the arm length and h is the base height. The 65 
differential kinematic model is obtained from Equation (31) 


T JE- dG 

[ 7 002 


dG dG 
003 ’ 004 


.W 0 2 G I 

J L 00! 2 ’ 002001 ’°’ U J 
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The 4x4 augmented Jacobian matrix J is now given by 


I -/sin0isin02 /cos0icos02 
/cos0isin02 Zsin0 1 cos02 


The singularities of J are found from 


■[si* 


[/sin02] = 0 


Hence J is singular when 0 2 =O, 180 degrees, i.e., when the 
tip is right above or below the base, or 


Hence, the singularities of the augmented Jacobian matrix 
are 0 X =45 degrees, 135 degrees or 0 2 =O, 180 degrees. For the 
tip coordinates to track the desired trajectories {x^(t), y rf (t), 
z d (t)} while minimizing the joint torque the required joint 

5 motions are obtained from 

( x d \ j -/sin0isin0 2 /cos0icos0 2 1 0 \ / 0 1 \ 

I /cos0isin0 2 /sin0icos0 2 Oil j 02 l 

z d 0 -Zsin0 2 00 J I 03 I 

0 j 2cos20isin 2 0 2 sin20isin20 2 0 0 J y 04 J 

Equation (43) can be solved recursively using the closed- 
loop damped-least-squares method to find 0 at each time 
increment, and the solution is then integrated to obtain the 
15 required joint motion 0, as in case study L 


which is the condition for saddle point in unconstrained 
optimization of G over 0 2 . Note that 0 2 =O, 180 degrees is a 
tip singular configuration, since in this case we lose control 
of the tip z-coordinate and the tip is at the workspace 
boundary. By way of an example, let us suppose that the tip 
is in contact with a vertical wall parallel to y-z plane and is 
exerting the Cartesian force 


on the wall. The joint torque required to produce the contact 
force F is given by 


t = y/(0)F = 


-/sin0isin0 2 /cos0isin0 2 0 
/cos0icos0 2 /sin0icos02 -/sin0 2 
1 0 0 

0 1 0 


- // x sin0isin02 
/fxCOS0lCOS0 2 
fx 


Suppose that the additional task for redundancy resolution is 
defined as minimization of the revolute joint torque x l9 i.e. 

sin 0! sin 0 2 ) 2 (39) 

In this case, we obtain 

r)C 

~ dQ- - = 2(-//*sinGisin0 2 )(-/JxCOS0isin02) = / 2 / x 2 sin20isin 2 0 2 
Hence, the optimality condition reduces to 


<f>(0)=sin 20 j sin 2 0 2 =O (40) 

Therefore, the arm is in the optimal configuration when 
0!=O, 90 degrees, 180 degrees, 270 degrees, 360 degrees or 
0 2 — 0, 180 degrees. The augmented Jacobian matrix is 


-/sin0]sin0 2 Jcos0icos02 1 0 

/cos0isin02 /sin0]cos02 0 1 

0 -Jsin0 2 0 0 

2cos20isin 2 0 2 sin20isin20 2 00 


Case Study 3: Spatial 3R-1P Mobile Robot 

In this case study, we consider a spatial three-jointed arm 
on a one DOF mobile platform, as shown in FIG. 6. This 
resembles a PUMA robot (without wrist motions) mounted 
on a rail to obtain base mobility. Let us denote the waist joint 
by 0 l9 the shoulder joint by 0 2 , the elbow joint by 0 3 , and let 
0 4 represent the platform mobility in x-direction, treated as 
a prismatic joint. Let us first assume that the robot base is 
stationary, i.e., 0 4 =O. Then the forward kinematic model 
relating the joint angles 0=(0!, 0 2 , 0 3 ) r to the tip Cartesian 
coordinates Y=(x, y, z) T in the reference world frame are 
readily found to be 


x=l cos 0j[ sin 0 2 +sin (0 2 +0 3 )];y=/ sin 0j[ sin 0 2 +sin (02+0 3 )]z=/ 
cos 0 2 +cos (0 2 +0 3 )1 +/j ( 44) 

where h is the shoulder height and 1 is the length of the 
upper-arm or forearm, and is set to unity and simplicity. The 
differential kinematic model of the robot is Y e =J(0)0, where 
the elements of the 3x3 hand Jacobian matrix are obtained 
from Equation (44) as 

Jen = ^ =-sin0i[sin02 + sin(0 2 + 03)]; 

3x 

J e \2 = -jjg- = COS01 [COS02 + COS(0 2 + ©3)] 
dx 

Je \3 ~ =COS0 iCOS( 0 2 + 03); 


= cos0i[sin0 2 + sin(0 2 + 63)] 


dy , 


= sin0i[cos0 2 + cos(0 2 + 63)]; 


Je 23 = gQ = sin0icos(0 2 + ©3) 


J e 32 = -00^- = -sin0 2 - sin(0 2 + 03); 


^33 - 00^ = -sin(02 + ©3) 


The singular configurations of the arm are found from 


det J=21 cos 20 j sin 3 0 : 


(42) 


det[J]=sin 0 3 [ sin 0 2 +sin (0 2 +0 3 )] 


(45) 
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sin 03 = 0 

0 

II 

CD 

t 

arm fully extended 

elbow singularity 

03 = 180° 

arm fully folded 

sin 02 + sin (©2 + 83 ) = 0 

0 

11 

II 

X 

T 

hand is straight 

shoulder singularity 


above the shoulder 


Note that case I singularities correspond to the hand on the 
outer (0 3 =D) or inner (0 3 =1 80 degrees) workspace boundary, Q 
and in case II the joint 0 2 does not affect (x, y, z) of the hand 
and hence a joint DOF is ineffective. The above results are 
the classical singularities of the PUMA arm which are 
well-known and are repeated here for comparison with the 
mobile platform case. 

Now, let us introduce base mobility to the system through 15 
the prismatic joint 0 4 . Since 0 4 is along the x-axis, we obtain 
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Notice that the Jacobian matrix J has a particular structure, 
with zero elements indicating that some joint angles have no 
effect on certain task variables. In order to control the task 
variables (x, y, z, <j>) independently, the augmented Jacobian 
matrix J must be nonsingular. The singularities of J are found 
from 


det[J]=-J e2l J e 32 =cos 0J sin 0 2 +sin (0 2 +0 3 )] 2 


(52) 


x=l cos 0J sin 0 2 +sin (0 2 +0 3 )+0 4 (46) 
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but y and z in Equation (44) are not affected. The new hand 
Jacobian J e will now be a 3x4 matrix with the fourth column 
as 

, dx . , ... dz n (47) „ 

Jeli =_ 3e7 l ’ lm= ~d&T <Ue34 ~5eT =0 25 

Let us now consider the coordinated control of the arm and 
the platform. The robotic system in FIG. 6 is kinematically 
redundant since infinite combinations of joint motions 0(t) 
can produce the same tip trajectory Y(t). This redundancy 30 
can be resolved by picking out an appropriate solution from 
this infinite set that meets a user-defined additional task 
requirement. In this case study, we define the “elbow angle” 


Note that the simplicity of det[J] is a consequence of the 
particular structure of J. From Equation (52), it is seen that 
J is singular when: 

I: cos0i — 0 -> 0! = 90°, 270° x = 0 4 

base singularity 

II: sin02 + sin(02 + 83) = 0 — > x= 0 4 , y = 0 

shoulder singularity 

To investigate these singularities, we study the augmented 
Jacobian matrix in these singular configurations. At the 
singular condition I, the hand and the platform have the 
same x-coordinate, i.e., the hand-base line is perpendicular 
to the x-axis. In this case, we obtain 


-sin02 - sin(02 + 03) 




<)> between the upper- arm and forearm as the kinematic 40 


o 

0 

0 


0 

COS02 + cos(02 + 03) 
-sin02 - sin(02 + ©3) 
0 


0 1 ' 

cos (02 + 0 3 ) 0 

—sin (0 2 + 63 ) 0 

1 0 / 


function to be controlled independently of the tip position 
for redundancy resolution. The elbow angle <j)=180 degrees^ 
0 3 determines the “reach” of the arm AP, since 


It is seen that the first and fourth columns of J are multiples 
of one another, and hence 0! and 0 4 have identical incre- 
mental effects on the task variables {x, y, z, (j)}. At the 
45 singular condition II, the hand is right above the base, and 
in this case we have 


AP=l sin 0/2+J sin 0/2=2 sin 0/2 (48) 

Hence by controlling ()) we can directly influence the reach 

of the arm. By introducing the elbow angle <j) as the fourth 
task variable, the forward and differential kinematic models 
of the robot are augmented by 

0(0)=18O°+0 3 (49) 

00 (50) 

/ c( 0) = ^ [O , 0,1,0] 

Hence, the 4x4 augmented Jacobian matrix relating the rate 
of change of task variables to the joint velocities has the 
following structure 


'0 COS 0 j[cOS 02 + cos (02 + 03 )] COS 0 iCOS (©2 + © 3 ) l 1 

0 sin 0 i[cos 02 + cos (02 + 03 )] sin 0 i cos (02 + © 3 ) 0 

0 0 -sin( 0 2 + 0 3 ) 0 

1 0 0 1 0 1 

Since the first column of J is zero, 0 X has no instantaneous 
55 effect on any of the task variables {x, y, z, §} in this 
configuration. 

In comparison with the previous case for the stationary- 
base robot, it is seen that the base mobility has alleviated the 
elbow singularity (sin 0 3 =O), i.e., the arm is no longer 
60 singular when it is fully extended or fully folded. However, 
a new singularity has been introduced (cos 0!=O) when the 
hand and base line up; which is not a classical PUMA 
singularity and is due to the additional task variable <(). Note 
that if the platform position 0 4 is chosen as the additional 
65 task variable instead of the elbow angle <|), i.e., the platform 
position is commanded and controlled directly, then the 
augmented Jacobian becomes 
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suggests that J3 must be an inverse function of a, and here 
we choose a simple function as j3=l/(a+l). Equation (55) is 
now solved for three different values of the base velocity 
weighting a=0, 1, 10 with corresponding elbow angle 
weighting {3=1, 0.5, 0.091. The simulation results are shown 5 
in FIGS. Ha-8h, and the steady-state values are given in 
TABLE 4. 
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Since the robot system shown in FIG. 9 has five inde- 
pendent joint degrees-of-freedom, we can control another 
task variable in addition to {x, y, z, \| /}. In this case study, 
the additional task variable is chosen as the “elbow angle” 
<j> formed between the upper-arm SE and the forearm EW, as 
in case study 3. The elbow angle <j> is related to the joint 
angles by 


TABLE 4 


Effect of a and p on steady-state 
performance in case study 3 



t (sec) 

x (cm) 

y (cm) 

z 

(cm) 

<J> 

(deg) 

6a 

(deg) 

02 

(deg) 

0 3 

(deg) 

04 

(cm) 

a = 0 

P = 1 

2.0 

386.6 

50.0 

225.0 

90.0 

49.1 

72.9 

-90.0 

343.3 

a = 1 
p = 1/2 

2.0 

383.9 

48.2 

220.5 

94.3 

35.2 

77.6 

-85.7 

315.5 

a = 10 
P = 1/11 

2.0 

351.3 

41.1 

202.7 

152.2 

14.4 

72.0 

-27.8 

191.8 


It is seen that as a increases and (3 decreases, the base motion 
is reduced but the task performance is also degraded. How- 
ever, since the § constraint is relaxed automatically in this 25 
case, we observe a better tracking performance in the hand 
coordinates (x, y, z), as compared to the previous case. 
Recall that since (x /5 y p z ,j) is outside the robot workspace if 
the base is stationary, base motion is necessary even if only 
hand motion is specified. 30 

Case Study 4: Spatial 4R-1P Mobile Robot 
Consider a spatial 4R arm with roll and pitch shoulder 
joints 0 lt 8 2 , and roll and pitch elbow joints 0 3 , 0 4 , mounted 
on a mobile platform as shown in FIG. 9 , where the base 
motion along the x-axis is treated as a prismatic joint 0 5 . 35 
This robotic arm is analogous to the human arm which has 
3 degrees-of-freedom at the shoulder and one joint at the 
elbow. Essentially, the 4R arm is obtained by adding the 
elbow roll motion 0 3 to the conventional 3R PUMA arm 4Q 
geometry given in case study 3. The addition of the elbow 
roll enables the elbow to move out of the vertical plane and 
thus provides considerable dexterity and versatility in 
executing tasks that demand human-like manipulative capa- 
bilities. In fact, the presence of four joints on the arm enables 45 
independent control of the wrist Cartesian coordinates {x, y, 
z} as well as the arm angle defined as the angle between 
the plane passing through the arm and the vertical plane 
passing through the shoulder-wrist line. The forward kine- 
matic model relating {x, y, z, \\f} to {0 2 , 0 2 , 0 3 , 0 4 , 0 5 } has 50 
been found to be 

X = CjS 2 + CjS 2 C 4 + S 4 (CjC 2 C 3 — SjS 3 ) + 65 (58) 

>' = SjS 2 + SjS 2 C 4 + S 4 {SjC 2 C 3 + CjS 3 ) 

z = c 2 + c 2 c 4 - s 2 c 3 s 4 + d ^ 

f 54 1 

v = atan2 \ “ [C2S4 + S2Cj(l + c 4 )] 1 = atan2{u, v) 

where u and v are the arguments of the atan2 function, 
r=( 2 + 2 c 4 ) 1/2 denotes the reach of the arm (i.e., the shoulder- 60 
wrist distance SW), h is the shoulder height, the upper-arm 
and forearm lengths are taken to be unity (SE=EW=1), the 
shoulder and elbow joints have zero offsets, and s=sin 0 £ , 
Cf=cos 0 t . Note that when there is no elbow roll motion 
(0 3 =0), we obtain xp==0, i.e., the arm stays in the vertical 65 
place, Equation (58) reduces to Equation (44), and the 
PUMA robot in case study 3 is retrieved. 


<H80°+8 4 (59) 

and determines the reach of the arm. From triangle WEF, we 
obtain 


p=SW=21 sin (j>/2=2 sin <j>/2 (60) 

Hence the arm reach r is a simple sinusoidal function of the 
elbow angle <j>, and § can be used to control r directly. This 
equation can also be obtained by applying the cosine law to 
the SEW triangle and using the half-angle cosine formula. 
Notice that the arm angle \\f and the elbow angle (j) represent 
two independent configuration parameters for the arm. The 
radius of the circle traversed by the elbow when the arm is 
executing a self-motion (i.e., wrist is fixed) is a function of 
the elbow angle as EF=1 cos <|>/2. The variation of the arm 
reach r as a function of the elbow angle (j) is shown in FIG. 
10 . It is seen that when § changes in the range {0, 180 
degrees}, r varies from 0 to 2; with r=0 at <j)=Q (arm fully 
folded) and v=2 at (j)=180 degrees (arm fully extended). Now 
let (x, y, z) represent the coordinates of the wrist and 0 5 be 
the x-coordinate of the base. The shoulder- wrist distance S W 
is given by 

sin 2 ty2=(x-Q 5 ) 2 +f+(z-hf (61) 

For a given wrist position W, the elbow angle (j) is deter- 
mined solely by the base location 0 5 . To attain a desired 
elbow angle 6, the required base location is found from 
Equation (61) as 


Q s =x±w (62) 

where oo 2 =4 sin 2 (J>/2-y 2 -(z-h) 2 . Equation (62) gives two 
solutions for the platform position 0 5 , given the desired 
elbow angle d>. These solutions are symmetrical about the 
line perpendicular from W onto the x-axis. 

Equations (58)— (59) represent the augmented forward 
kinematic model of the robot system. The augmented dif- 
ferential kinematic model relating the joint velocities {0!, 
0 2 , 03, 0 4 , 0 5 } to the resulting task variable velocities {x, 
y, z, \j /, <j>} is obtained by differentiating Equations (58)-(59) 
as 
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10 


Because of the particular structure of the 5x5 augmented 
Jacobian matrix J, the expression for det[J] simplifies con- 
siderably to 


15 


det[J]~~J 21 [hlhz~h2^43^ 


( 64 ) 20 


The elements of J that appear in Equation (63) can be 
obtained from Equation (58) as 


= C\S 2 + C\S2C4 + £l C 2 C 3 S 4 — S\Si>St = X — 9, 


J _ dy 

h '-~SST' 

dz 

hi - - = -.*2 “ J 2 C 4 ~ C2C3S4 = -PQ 
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where PQ=(x 2 +y 2 ) 1/2 is the distance between the wrist 
projection on the x-y plane P and the robot base Q, and the 
partial derivatives in the above expressions are given by 

dti dv J4 r , m , o 45 

' = C 2 S 3 S 4 ', : ^ = ~ L-J2-S4 + ^2^3 U + C*)] 

du dv r 

~ae7~ = = — [-*2*3 (1 + C 4 )J 


Substituting these expressions into Equation (64) and sim- 50 
plifying the result yields the surprisingly simple expression 


det[J]~rs 2 (Q 5 -x) (65) 

This analysis shows that the arm-plus -platform system has 
the following singular configurations: 


I: 

05 — x^O 

— » 

x = e. 

wrist and platform have 
the same x-coordinate 

II: 

S2 = 0 

— > 

02 = 0, 180° 

upper-arm is vertical 

III: 

r = 0 


04= 180° 

arm is fullv folded 


In singular configuration I (i.e., x=0 5 ), the first and fifth 
columns of J are multiples and hence 0j and 0 5 have 65 
identical effects on the task variables. In singular configu- 
rations II and HI (i.e., s 2 =0 and c 4 =-l), the 2x2 submatrix 


( hi hi \ 
hi hi ) 

of J becomes rank-deficient, and hence the joint angles {0 2 , 
0 3 } do not affect the task variables {z, \|/} independently. 

Suppose that the motion trajectories X rf (t)=[x^(t), y rf (t), 
z d (t), \}/ 4 (t), <() rf (t)] :r are specified for the task variables. Then 
the required joint motions can be obtained by finding the 
closed-loop damped-least-squares solution of 
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that minimizes the cost function 
as 

Q=[J T W t J + W v r 1 J T W t [X^KiX^X)] (67) 

Typically, the pitch angle 0 4 can vary in the range -180 
degrees ^0 4 ^O degrees and hence the range of variation of 
the elbow angle $ is 0 degrees to 180 degrees. The most 
desirable elbow angle is (|)=90 degrees, which corresponds to 
the pitch angle 0 4 in mid-range and ensures that the arm is 
not in an over-stretched (<j)~180 degrees) or an under- 
stretched (<|»=0 degrees) configuration. The elbow condition 
(|)=90 degrees can also be derived from another point of 
view. For the robot arm shown in FIG. 9 , the upper-arm SE 
and forearm EW define the arm plane A. The robot can be 
viewed as a two-link planar arm with joint rotations 0 2 and 
0 4 which move the arm in the plane A. The arm plane A can 
rotate about the shoulder roll axis by 0j and about the 
upper-arm by 0 3 . 

When the robot base is stationary (0 5 =O), the wrist attains 
maximum manipulability when 0 2 -0 4 =9O degrees, which is 
the classical two-link arm result. Hence ensuring that the 
elbow angle <j)=90 degrees guarantees the optimality of the 
wrist manipulability in the arm plane A when 05=0. 

Having established the desirability of the (j)=90 degrees 
condition based on the above arguments, the platform can be 
positioned continuously to attain the target elbow angle 
0=90 degrees while the wrist is executing the specified 
motion. Since the platform motion is often considerably 
slower than the arm movement, it is preferrably not to move 
the platform continuously. To this end, instead of tracking 
the constraint <j)=90 degrees accurately, we can impose the 
inequality constraint 


90 o -8^90°+S (68) 

where 6 is a user- specified tolerance or margin. When the 
elbow angle <j ) is within the allowable bounds, the task 
weighting factor for (j) is set to zero, and in this case base 
mobility will not be activated [unless the target wrist posi- 
tion is otherwise unattainable]. When <|> is outside these 
bounds, i.e., (j»90 degrees +5 (arm over- stretched) or (j)<90 
degrees -5 (arm under-stretched), the task weighting for <j) 
changes smoothly to one as shown in FIG. 11 and the 
platform is moved automatically to restore the optimal 
configuration (|)=90 degrees, without perturbing the wrist 
position. Thus, the automatic motion of the platform pre- 
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vents undesirable over-stretched or under-stretched arm con- 4. The method recited in claim 1 wherein said mobile 

figurations, while enabling the wrist to reach positions in the robot is a gantry robot. 

workspace that would otherwise be unattainable. 5. The method recited in claim 1 wherein said mobile 

robot is a wheeled robot. 


CONCLUSIONS 

A simple scheme is disclosed for coordinating mobility 
and manipulation in a mobile robot system. The n b degrees- 
of-mobility are added to the n fl degrees-of-manipulation, and 
the overall n a +n fr degrees-of-freedom (DOF) are used to 
accomplish a set of user-defined tasks in addition to end- 
effector motion. This formulation puts the mobility DOF on 
the same footing as the manipulation DOF and treats them 
equally within a common framework. 

The key advantages of the present approach over the 
previous schemes are its flexibility, simplicity, and compu- 
tational efficiency. The ability to change the task specifica- 
tions and the task weighting factors on-line based on the user 
requirements provides a flexible framework for mobile robot 
control. Furthermore, in contrast to previous approaches 
which are suitable for off-line motion planning, the simplic- 
ity of the present approach leads to computational efficiency 
which is essential for on-line control in real-time implemen- 
tations. 

Having thus described a preferred embodiment of the 
invention, what is claimed is: 

1. A method of controlling a mobile robot, the robot of the 
type having a mobile base having at least one degree of 
mobility and a manipulatable arm having at least one degree 
of manipulation; the method comprising the steps of: 

(a) generating a forward kinematic model that relates arm 
and base joint coordinates to end-effector coordinates; 

(b) generating a differential kinematic model that relates 
end-effector velocity to arm and base joint velocities 
including Jacobian matrices of the arm and base, 
respectively; 

(c) augmenting by column the arm Jacobian matrix with 
the base Jacobian matrix to obtain an overall end- 
effector Jacobian matrix where the availability of base 
mobility appears as extra columns in the end-effector 
Jacobian matrix because of effectively increasing the 
dimension of the joint space; 

(d) augmenting by row the end-effector Jacobian matrix 
of step (c) with a constraint Jacobian matrix which 
relates to a user-defined additional task to be accom- 
plished due to kinematic redundancy where said addi- 
tional task results in extra rows in the end-effector 
Jacobian matrix due to an increase of the task space; 

(e) selecting end-effector and constraint task weighting 
factors and arm and base joint velocity weighting 
factors; 

(f) finding the optimal arm and base motions using a 
closed-loop damped-least-squares approach; and 

(g) moving the arm and base of said robot in accordance 
with the optimal motions resulting from carrying out 
steps (a) through (f). 

2. The method recited in claim 1 wherein said kinematic 
redundancy recited in step (d) results from a task space 
which is at least one dimension less than the sum of the 
re volute joints and prismatic joints of said robot. 

3. The method recited in claim 1 wherein said mobile 
robot is a tracked robot. 


5 6. The method recited in claim 1 wherein said mobile 

robot is a compound robot. 

7. The method recited in claim 1 wherein the number of 
degrees-of-freedom of said mobile robot is equal to the sum 
of the number of degrees-of-manipulation of said arm and 

10 the number of degrees-of-mobility of said base. 

8. The method recited in claim 1 wherein said end-effector 
and constraint task weighting factors are selected on-line 
based on user requirements for real-time implementation of 
on-line control of said mobile robot. 

15 9. A method for on-line, real-time control of a mobile 

robot having a mobile base and a manipulatable arm 
mounted on the base to provide a number of degrees-of- 
freedom equal to the sum of the number of degrees-of-base- 
mobility and the number of degrees-of-arm-manipulation, 

20 the robot operating in a multi-dimension task space wherein 
the number of task-space-dimensions is less than the 
degrees-of-freedom; the method comprising the steps of: 

(a) generating a forward kinematic model that relates arm 
and base joint coordinates to end-effector coordinates; 

25 (b) generating a differential kinematic model that relates 

end-effector velocity to arm and base joint velocities 
including Jacobian matrices of the arm and base, 
respectively; 

(c) augmenting by column the arm Jacobian matrix with 

30 the base Jacobian matrix to obtain an overall end- 
effector Jacobian matrix where the availability of base 
mobility appears as extra columns in the end-effector 
Jacobian matrix because of effectively increasing the 
dimension of the joint space; 

35 (d) augmenting by row the end-effector Jacobian matrix 

of step (c) with a constraint Jacobian matrix which 
relates to a user-defined additional task to be accom- 
plished due to kinematic redundancy where said addi- 
tional task results in extra rows in the end-effector 

40 Jacobian matrix due to an increase of the task space; 

(e) selecting end-effector and constraint task weighting 
factors and arm and base joint velocity weighting 
factors; 

45 (f) finding the optimal arm and base motions using a 

closed-loop damped-least-squares approach; and 

(g) moving the arm and base of said robot in accordance 
with the optimal motions resulting from carrying out 
steps (a) through (f). 

50 10. The method recited in claim 9 wherein said kinematic 

redundancy recited in step (d) results from a task space 
which is at least one dimension less than the sum of the 
re volute joints and prismatic joints of said robot. 

11. The method recited in claim 9 wherein said mobile 

55 robot is a tracked robot. 

12. The method recited in claim 9 wherein said mobile 
robot is a gantry robot. 

13. The method recited in claim 9 wherein said mobile 
robot is a wheeled robot. 

60 14. The method recited in claim 9 wherein said mobile 

robot is a compound robot. 

* * * * * 



